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ABSTRACT 

We  analyze  the  possibility  of  using  arrays  of  accelerometers  as  Inertial  Navigation  Systems  (INS)  for  Unmanned 
Aerial  Vehicles  (UAV).  Benefiting  from  the  fabrication  processes  of  MEMS  technologies,  accelerometers  now  offer 
several  advantages  over  gyroscopes,  such  as  low  weight,  compactness,  high  reliability  and  low  cost,  for  example. 
An  algorithm  is  introduced  which  allows  the  computation  of  the  angular  acceleration  and  the  angular  velocity  of 
a  UAV  from  measurements  of  n  uniaxial  accelerometers  located  at  n  arbitrary  points  on  the  UAV  By  uniaxial 
accelerometer  we  mean  a  sensor  that  allows  the  measurement  of  only  one  point-acceleration  component.  It  is  shown 
that  the  necessary  conditions  for  the  algorithm  to  work  are  that  n  be  greater  than  or  equal  to  nine,  that  the  points  be 
non-collinear,  and  that  the  vectors  pointing  in  the  sensitive  directions  of  all  the  sensors  span  the  whole  3D  space. 
Notice  that  such  analyses  have  been  performed  before,  but  only  for  specific  strapdowns  and  never  for  a  completely 
general  case,  in  which  the  positions  and  the  orientations  of  the  sensors  are  arbitrary,  except  for  the  conditions  stated 
above.  In  the  linear  algebraic  system  of  3 n  equations  in  2n  +  9  unknowns  that  has  to  be  solved  to  compute  the 
angular  acceleration  and  the  angular  velocity,  the  coefficients  of  the  unknowns  depend  only  on  the  geometry  of 
the  accelerometer  strapdown,  and  not  on  the  measurements.  Therefore,  the  condition  number  of  the  algebraic  linear 
system  gives  an  upper  bound  of  the  error  amplification  incurred  when  solving  the  linear  system  for  any  accelerometer 
measurements,  which  makes  the  condition  number  a  suitable  performance  index  for  the  design  of  UAV  accelerometer 
strapdowns.  With  regard  to  this  new  performance  index,  a  comparison  of  the  accuracies  of  existing  accelerometer 
strapdowns  is  conducted.  Moreover,  an  error  analysis  is  provided,  taking  into  account  stochastic  errors — noise — and 
deterministic  errors — bias — in  the  sensor  outputs.  Results  of  numerical  simulations  are  included  to  validate  the  error 
models  and  to  assess  the  real-time  capabilities  of  the  algorithm.  Finally,  a  comparison  between  the  performances  of 
all-accelerometer  strapdowns  and  the  traditional  gyroscope-accelerometer  INS  is  reported. 

1  INTRODUCTION 

New  operation  requirements  call  for  small,  low-cost  UAVs  for  high-risk  recognition  missions.  As  an  example, 
the  Dragon  Eye ,  which  is  shown  in  Fig.  1,  is  meant  to  perform  “over-the-hill”  reconnaissance  missions  for  ground 
personnel.  Because  these  UAVs  are  to  become  widely  used,  their  unit  price  needs  to  be  kept  very  low.  As  their 
structure  and  propellers  are  relatively  simple,  a  significant  part  of  the  price  of  such  UAVs  comes  from  their  Inertial 
Navigation  System  (INS).  Within  the  INS,  gyroscopes  are  the  limiting  factor  regarding  cost  and  accuracy  (Zorn, 
2002).  Indeed,  the  price  for  fiber  optic  angular-rate  sensors  is  in  the  order  of  thousands  of  euros,  whereas  it  is  in 
the  order  of  ten  euros  for  an  accelerometer.  There  also  exist  mechanical  gyroscopes  for  which  the  price  is  more 
reasonable — a  few  tens  of  euros.  However,  these  devices  show  very  poor  accuracy — typically  100  times  less  than 


Cardou,  P.;  Angeles,  J.  (2005)  A  Comparative  Study  of  All-Accelerometer  Strapdowns  for  UAV  INS.  In  Advanced  Sensor  Payloads 
for  UAV ( pp.  9-1  -  9-16).  Meeting  Proceedings  RTO-MP-SET-092,  Paper  9.  Neuilly-sur-Seine,  France:  RTO.  Available  from: 
http :  / /  www .  rto  .nato .  int/ ab  strac  ts .  asp . 


RTO-MP-SET-092 


9-1 


UNCLASSIFIED/UNLIMITED 


Report  Documentation  Page 

Form  Approved 

OMB  No.  0704-0188 

Public  reporting  burden  for  the  collection  of  information  is  estimated  to  average  1  hour  per  response,  including  the  time  for  reviewing  instructions,  searching  existing  data  sources,  gathering  and 
maintaining  the  data  needed,  and  completing  and  reviewing  the  collection  of  information.  Send  comments  regarding  this  burden  estimate  or  any  other  aspect  of  this  collection  of  information, 
including  suggestions  for  reducing  this  burden,  to  Washington  Headquarters  Services,  Directorate  for  Information  Operations  and  Reports,  1215  Jefferson  Davis  Highway,  Suite  1204,  Arlington 

VA  22202-4302.  Respondents  should  be  aware  that  notwithstanding  any  other  provision  of  law,  no  person  shall  be  subject  to  a  penalty  for  failing  to  comply  with  a  collection  of  information  if  it 
does  not  display  a  currently  valid  OMB  control  number. 

1 .  REPORT  DATE  2.  REPORT  TYPE 

01  MAY  2005  N/A 

3.  DATES  COVERED 

4.  TITLE  AND  SUBTITLE 

A  Comparative  Study  of  All-Accelerometer  Strapdowns  for  UAV  INS 

5a.  CONTRACT  NUMBER 

5b.  GRANT  NUMBER 

5c.  PROGRAM  ELEMENT  NUMBER 

6.  AUTHOR(S) 

5d.  PROJECT  NUMBER 

5e.  TASK  NUMBER 

5f.  WORK  UNIT  NUMBER 

7.  PERFORMING  ORGANIZATION  NAME(S)  AND  ADDRESS(ES) 

Department  of  Mechanical  Engineering  &  Centre  for  Intelligent 

Machines  McGill  University  817  Sherbrooke  St.  West  Montreal,  QC  H3A 
2K6 

8.  PERFORMING  ORGANIZATION 

REPORT  NUMBER 

9.  SPONSORING/MONITORING  AGENCY  NAME(S)  AND  ADDRESS (ES) 

10.  SPONSOR/MONITOR’S  ACRONYM(S) 

11.  SPONSOR/MONITOR’S  REPORT 
NUMBER(S) 

12.  DISTRIBUTION/AVAILABILITY  STATEMENT 

Approved  for  public  release,  distribution  unlimited 

13.  SUPPLEMENTARY  NOTES 

See  also  ADM202032.,  The  original  document  contains  color  images. 

14.  ABSTRACT 

15.  SUBJECT  TERMS 

16.  SECURITY  CLASSIFICATION  OF:  17.  LIMITATION  OF 

1 8 .  NUMBER  1 9a.  NAME  OF 

rtR  DArTRQ  Pin  QDCtMQTPT  P  DRbQflM 

a.  REPORT  b.  ABSTRACT  c.  THIS  PAGE  jjjj 

unclassified  unclassified  unclassified 

16 

Standard  Form  298  (Rev.  8-98) 

Prescribed  by  ANSI  Std  Z39-18 


UNCLASSIFIED/UNLIMITED 

A  Comparative  Study  of  All-Accelerometer  Strapdowns  for  UAV  INS 


ORGANIZATION 


Figure  1 :  The  Dragon  Eye ,  by  AeroVironment  Inc. 


their  optical  counterparts — and  tend  to  be  unreliable  because  they  require  a  spinning  top.  Moreover,  gyroscopes  are 
in  general  bulkier  and  more  power-demanding  than  accelerometers,  which  calls  for  larger  battery  packs.  As  a  small 
UAV  such  as  the  Dragon  Eye  is  to  be  backpack  portable  and  launched  by  hand  or  by  means  of  a  simple  bungee  rope, 
weight  is  an  important  issue. 

From  all  these  problems  comes  naturally  the  idea  of  replacing  all  gyroscopes  by  an  array  of  accelerometers  that 
are  to  measure  acceleration  components  of  a  constellation  of  points  on  the  vehicle.  If  the  vehicle  is  regarded  as  a 
rigid  body,  knowing  the  accelerations  of  several  landmark  points  allows  one  to  find  the  kinematic  variables  of  the 
vehicle,  that  is,  its  angular  acceleration  Co,  its  angular  velocity  co,  its  attitude,  which  we  will  represent  here  by  a  four¬ 
dimensional  array  of  Euler-Rodrigue  parameters  77,  its  point-acceleration  p,  its  velocity  p  and  its  position  p.  This  is 
not  a  new  idea — see  Padgaonkar  et  al.  (1975),  Mostov  (2000),  and  Peng  and  Golnaraghi  (2004),  for  example — but 
it  has  only  been  implemented  with  little  success  in  limited  applications  until  now.  In  this  paper,  we  aim  at  shedding 
light  on  the  lack  of  success  of  previous  attempts;  whether  replacing  gyroscopes  by  accelerometers  is  feasible,  taking 
into  account  the  accuracy  offered  by  current  technology.  The  analysis  is  done  for  a  totally  general  case,  where  the 
vehicle  is  equipped  with  n  single-axis  accelerometers  taken  to  be  located  at  n  distinct  points  and  with  their 

sensitive  axes  parallel  to  corresponding  unit- vectors 


2  THE  ASSOCIATED  ALGEBRAIC  LINEAR  SYSTEM 

The  UAV  equipped  with  a  strapdown  of  n  accelerometers  is  schematized  in  Fig.  2.  The  ith  accelerometer  is 
attached  to  point  Pi  of  the  vehicle.  1Z  is  the  inertial  frame  with  origin  On,  frame  V  is  attached  to  the  vehicle, 
with  origin  Oy;  and  frame  Ai,  i  =  1, . . . ,  n,  is  also  attached  to  the  rigid  body,  with  origin  Pi,  and  with  its  x-axis 
pointing  in  the  positive  sensing  direction  of  the  ith  accelerometer.  Vector  p  is  directed  from  point  On  to  point 
Os,  while  p^  is  directed  from  point  On  to  point  Pi.  We  also  define  the  geometric  centre  C  of  the  accelerometers 
pc  =  (l/n)  P*  anc*  ri  —  Pi  ~  Pc-  Moreover,  matrix  Q  rotates  frame  1Z  onto  frame  V,  while  matrix  rotates 
frame  V  onto  frame  Ah. 

The  angular  acceleration  Co  and  the  angular  velocity  co  can  be  computed  from  the  equation  of  rigid-body  motion 
of  elementary  mechanics: 

Pi  =  Pc  +  u  x  (Pi  -  Pc)  +  U  x  x  (jij  -  pc) .  (1) 

This  equation  can  be  rewritten  in  the  more  compact  form 

Pi  -  PC  =  Wr i,  i  =  1, . . . ,  n,  (2) 
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Figure  2:  The  Dragon  Eye  and  hypothetic  measurement  points 


where  W  =  ft  +  ft2,  and  ft  is  the  cross-product  matrix1  (CPM)  of  a?.  W  can  be  referred  to  as  the  angular 
acceleration  matrix,  as  in  Angeles  (2003).  Equations  (2)  can  be  rewritten  as 

1  n 

Qi[PiU; - =  Wrl?  i  =  1, . . .  ,n.  (3) 

U  3= 1 

Let  us  now  partition  the  rotation  matrices  into  three  column-vectors  and  define  the  components  of  in  their 
corresponding  frames  At: 


Q i  =  [q*i  q*2  q«] ,  [p;]a 


CLi2 

®i3 


(4) 


As  acceleration  component  an  is  along  the  sensitive  axis  of  the  ith  accelerometer,  and  is  hence  assumed  to  be  known, 
whereas  the  two  other  components  remain  unknown.  Thus,  eq.  (3)  becomes 


O'ilQil  +  <^2qi2  +  CLi3^i3  —  cx 


1 

n 


53  aJ2qj‘2 

3= 1 


1  n 

“E8^'3  =  Wri’  i  =  1, . . .  ,n, 


3= 1 


(5) 


where 


1  n 


3= 1 

With  cx  defined  as  the  centroid  of  all  the  measured  components  of  the  point-accelerations  expressed  in  the  body 
frame  £>.  We  move  all  unknown  terms  of  eq.  (5)  to  the  right-hand  side,  thus  obtaining 


anq.n  ~  c*  =  Wr;  -  ai2q*2  -  a;3q;3  +  -  53  ai2qi2  +  “  53  ai3qi3’  *  =  1>  •  •  •  > (6) 

known  v _ 


n  z '  n 
3= 1  j=i 


unknown 


^PMiv)  is  defined  as  <9(v  x  x)/<9x,  for  any  x  E  R3,  with  v  G  M3  as  well. 
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Further,  we  partition  W  into  three  row- vectors: 


W 


T~\ 
W 


Wo 


(7) 


3= 1 


n 


This  allows  us  to  rewrite  eq.  (6)  as 

il  —  Cx  =  RjW  —  a«2qi2  —  «i3qi3  +  ~  ^  aj2<lj2  +  ~  ^  aj3qj3,  i  =  1,  .  .  .  ,  U, 

where 

R,; 


(8) 


3= 1 


r  T 

0T 

1 

b 

O 

Wj 

0T 

T 

ri 

0T 

ii 

£ 

T3 

§ 

w2 

0T 

0T 

T 

ri  J 

_w3_ 

From  eq.  (8),  we  cast  the  set  of  matrix  equations  into  a  single  one: 

Rw  +  Aa  =  b, 


where 


R 


Ri 

R2 

Rn 


A  = 


aqi2  aqi3  /?q22  /?q23 
0  qi2  /?qi3  aq22  aq23 


_/?qi2  /?qi3  0  q22  /?q23 
with  a  =  (1  —  n)/n,  0  =  1/n,  and 

b  = 


0Qn2  0<ln3 
0Q.n2  0<ln3 


a 


«12 

^13 

«22 

^23 

.^n3. 


ttliqil  - 

«2iq2i  — 


Now,  we  rewrite  the  linear  system  of  eq.  (9)  as 


ttnlQ.nl 


Mx  =  b, 


where 


M  =  [A  R]  ,  and  x  [aT  w2 


(9) 


(10) 

(11) 


Matrix  W  is  thus  found  by  solving  the  foregoing  linear  system  of  3 n  equations  in  2n  +  9  unknowns.  One  can 
notice  that  matrix  M  in  eq.  (10)  depends  only  on  the  configuration  of  the  accelerometer  array  and  neither  on  the 
measurements  nor  the  orientation  of  frame  V  with  respect  to  frame  1Z.  Thus,  we  can  render  this  matrix  in  upper- 
triangular  form  off-line,  by  means  of  Householder  reflections  (Golub  and  Van  Loan,  1983),  thereby  obtaining  a 
system  in  the  form 

Ux  =  Hrb,  (12) 

where  U  is  a  3 m  x  2m  +  9  upper-triangular  matrix,  and  H  is  a  3 m  x  3m  orthogonal  matrix. 
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3  A  PERFORMANCE  INDEX  FOR  ACCELEROMETER  STRAPDOWNS 

3.1  The  Condition  Number  of  M 

For  starters,  we  ascertain  whether  M  is  of  full  rank.  From  eq.  (11),  we  draw  the  necessary  conditions  for  the 
associated  linear  system  to  be  either  determined  or  over  determined: 


1.  n  >  9; 

2.  points  {Pi }f=1  are  non-collinear; 

3.  vectors  {q^i}^  spanM3; 

4.  {PiYl—i  and  {qu} -l=1  are  chosen  so  that  the  columns  of  A  and  R  are  linearly  independent. 


As  matrix  M  depends  only  on  the  geometry  of  the  accelerometer  strapdown  and  not  on  the  measurements,  it 
can  be  used  as  a  performance  index  to  compare  different  strapdowns.  Indeed,  a  good  geometry  is  one  for  which  the 
error  in  the  acceleration  measurements  does  not  amplify  when  solving  eq.  (10).  The  condition  number  M)  gives 
a  measure  of  the  sensitivity  of  the  solution  of  a  linear  system  to  roundoff  errors,  i.e., 


ii^xii 


X 


<  k(M) 


\\m\  |  \m\ 


l|M|| 


|b||  J 


where  5x,  5 M  and  6b  are  the  errors  on  x,  M  and  b,  respectively.  However,  ft(M)  cannot  be  computed  directly 
here,  as  matrix  M  is  dimensionally  non-homogeneous.  We  normalize  this  matrix  using  the  concept  of  characteristic 
length: 

M  =  [A  (1//)R]  ,  (13) 

where  l  is  the  characteristic  length  of  the  accelerometer  strapdown,  and  is  defined  as  the  normalizing  length  l  result¬ 
ing  in  the  lowest  condition  number  of  A  augmented  with  nondimensionalized  R.  Hence,  we  can  write: 


M)  =  min(ft([A  ( 1  /  Z )  R] ) ) . 


(14) 


Here,  we  will  use  the  Frobenius  norm,  which  can  be  defined,  for  any  matrix  B  G  Mmxp  with  m  >  p,  as: 


|BIf  =  /^tr(BTB)  =  /~tr(BBT) 

Let  us  also  define  the  orthogonal  projectors  Pr  and  Pa  of  matrices  R  and  A,  respectively: 

Pr  =  l3nx3n  “  R(RTR)_1RT; 

Pa  =  l3nx3n  ~  A(ATA)-1  AT; 


(15) 


(16) 

(17) 


where  13^x3™  is  the  3 n  x  3 n  identity  matrix.  Using  the  Frobenius  norm  allows  us  to  obtain  symbolic  expressions 
for  the  characteristic  length  and  the  associated  condition  number,  namely, 


/  C  -| 

l  =  ,4/^-,  and  KF( M)  =  - - - 

/?7  K  J  2n  +  9 


07  + 


(18) 


where  a  =  3  Y^=  1  llrill’  /?  =  2n  —  2,  7  =  tr[(RTPaR)  1],  and  5  =  tr[(ArPrA 


\-n 


The  proof  of  these  relations  is  not  included  here  due  to  space  limitations,  but  is  available  upon  request. 
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Ps 


Figure  3:  A  sample  of  accelerometer  strapdowns  (a)  nine  accelerometers  (Padgaonkar  et  al.,  1975);  (b)  a  tetrahedron¬ 
shaped  strapdown  of  twelve  accelerometers,  Plato  (Parsa  et  al.,  2003b);  (c)  twelve  accelerometers  (Peng  and  Gol- 
naraghi,  2004);  and  (d)  proposed  strapdown  of  twelve  accelerometers  for  a  UAV 


3.2  Examples 

Using  this  new  performance  criterion,  we  can  evaluate  the  efficiency  of  some  accelerometer  strapdowns  which 
have  been  proposed  before.  A  sample  is  shown  in  Fig.  3,  along  with  a  new  possible  strapdown  geometry  for  a  UAV. 
We  obtain  the  condition-number  values  of  Table  1  for  the  shapes  depicted  in  Fig.  3,  where  ttp(M)  is  the  Frobenius- 
norm  condition  number  and  /^(M)  is  the  2-norm  condition  number.  The  edges  of  the  Platonic  solids  are  all  taken 
to  be  100  mm  long.  In  the  case  of  the  UAV-strapdown,  the  coordinates  of  points  {Pj}f=1  in  frame  V  are 


[pilv  = 

d° 

1 _ 

m,  [P2]y  = 

1 

i o 

o  o 

1 

1 _ 

m,  [P3]y  = 

0 

-0.5 

m,  and  [p4]v  = 

'  0  ' 

0.5 

0 

0.25 

0 

0 

Table  1 :  Properties  of  accelerometer  arrays 


accelerometer  array 

l 

kj?(M) 

k2(M) 

Padgaonkar  et  al.  (1975) 

135.3  mm 

2.50 

9.76 

Parsa  et  al.  (2003b) 

113.1  mm 

1.46 

3.16 

Peng  and  Golnaraghi  (2004) 

164.2  mm 

1.35 

3.15 

UAV  strapdown 

555.4  mm 

2.35 

11.66 
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One  can  see  that  the  condition  numbers  for  the  strapdown  of  Peng  and  Golnaraghi  (2004)  and  for  Plato  are  fairly 
low,  although  they  are  above  their  lower  bound  of  unity.  As  the  shape  of  the  UAV  constrains  the  geometry,  the 
resulting  strapdown  is  further  from  the  shape  of  a  Platonic  array,  and,  therefore,  its  condition  number  is  higher  than 
that  of  other  strapdowns. 

4  ERROR  ANALYSIS 

As  the  aim  of  this  paper  is  to  compare  the  accuracy  of  all-accelerometer  strapdowns  with  that  of  angular-rate 
sensor  strapdowns,  we  will  limit  the  error  analysis  to  the  computation  of  the  angular  acceleration  co  and  the  angular 
velocity  co. 

4.1  Error  on  the  Angular  Acceleration  co 

The  sources  of  error  affecting  the  angular  acceleration  matrix  can  be  classified  as  deterministic  or  stochastic. 
The  deterministic  errors  are 

1.  the  errors  on  the  position  of  the  accelerometers  {Sri}f=1; 

2.  the  errors  on  the  orientation  of  accelerometers,  which  can  be  represented  by  their  corresponding  rotation 
matrices  {SQi}f=1; 

3.  the  bias  errors  on  the  sensor  output  {5a^}^=1; 

4.  the  non-linearity  errors  and  the  scaling  errors,  which  we  label  altogether  as 

The  stochastic  errors  are  essentially  noise  in  the  accelerometer  outputs  Notice  that  no  knowledge  of  the 

gravity  field  is  required  to  compute  the  angular  acceleration  matrix.  Indeed,  uniform  accelerations  of  the  UAV  do 
not  contribute  to  any  of  its  rates  of  rotation.  However,  uniform  acceleration  does  have  an  effect  on  the  error  in  the 
angular  acceleration  matrix  if  there  are  errors  on  the  accelerometer  orientations,  that  is,  if  5Q^  7^  13x3,  where  13x3 
is  the  3  x  3  identity  matrix. 

In  our  case,  we  will  assume  that  the  accelerometer  strapdown  is  working  under  ideal  conditions,  that  is,  we 
assume  that  the  accelerometer  strapdown  has  been  calibrated  such  that  the  positions  and  the  orientations  of  all  the 
sensors  are  accurately  known.  Also,  the  UAV  is  taken  to  be  perfectly  rigid,  which  means  that  the  position  and  ori¬ 
entation  errors  remain  constant  throughout  the  flight.  We  also  assume  that  the  accelerometer  sensitivity  has  been 
characterized  and  accounted  for,  which  leaves  us  with  the  error  5an  =  Sa +  Safv  Here,  5aha  and  8 af1  will  be  con¬ 
sidered  as  random  variables  with  normal  probability  densities.  This  assumption  is  reasonable,  because  most  sensor 
characteristics  are  close  to  being  normally  distributed — for  example,  see  Analog  Devices  (2005). 

Now,  we  can  rewrite  eq.  (10)  in  normal  form: 


Mx  =  b,  (20) 

where  x  =  [aT  lwT]T .  From  previous  assumptions,  we  can  write  the  perturbed  system  of  eq.  (20)  as 

M  (x  +  5x)  =  b  +  5b.  (21) 

Notice  that,  since  the  only  source  of  errors  considered  comes  from  the  measurements,  matrix  M  is  known  accurately. 
We  simplify  the  perturbed  equation  using  eq.  (20),  which  leads  to 

M5x  =  5b.  (22) 
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As  all  the  equations  of  the  foregoing  linear  system  come  from  rigid-body  motion  equations,  the  system  is  overdeter¬ 
mined  only  in  its  form.  Therefore,  the  exaction  solution  can  be  obtained  by  finding  its  least-square  approximation. 
Symbolically,  this  is  done  using  the  Moore-Penrose  generalized  inverse: 

5x  =  Mf<5b,  (23) 


_ 4-  _ rp _  _ rji 

where  M  =  (M  M)-1M  .  We  now  take  the  2-norm  on  both  sides  of  the  equation,  which  yields 

||5x||2  =  \0Sb\\2. 

From  the  definition  of  the  2-norm,  eq.  (24)  can  be  rewritten  as  an  inequality,  namely, 


||6x||2  <  ||Mt||2||<5b||2. 


(24) 


(25) 


Here,  ||M^||2  depends  only  on  the  strapdown  geometry.  This  norm  can  be  computed  as  ||M'  ||2  =  1  / \Mmm>  where 
A. min  is  the  smallest  eigenvalue  of  MTM. 


liTrti 


On  the  other  hand,  5b  depends  on  the  acceleration  measurements.  From  eq.  (9),  we  obtain 


8b  = 


5anqn  —  8cx 
8(12 1 Q2  i  —  8cx 

^®nl9lnl  3cx 


(26) 


Hence,  the  2-norm  of  5b  becomes 


1 1 5b  1 1  §  =  5bT5b  =  y^(5aji)2  —  25c^  8anqn  +  n8cx8cx 


2=1 


2=1 


(27) 


From  eq.  (5),  we  find 


Therefore,  we  can  rewrite  eq.  (27)  as 


x 


1 

n 


3= 1 


ll^blll 


n  —  1 
n 


J2(5aii">2 

2=1 


1 

n 


n  n 

^^5aa5a7iqJ1q7i. 

2=1  j  =  1 
3+i 


(28) 


(29) 


We  replace  each  measurement  error  San  by  its  rms-value  Sarms  =  yj  (Sa^ms)2  +  (5aJ?ms)2,  where  8ahrms  and 
are  the  standard  deviations  of  the  bias  errors  and  the  noise,  respectively.  This  leads  to  the  approximative  inequality 


Ml 


< 


< 


(i Sar 


n  — 


1  n  n 

1  + 


2  =  1  j  =  1 


J 


2 (ti  l)(5urms)  . 


(30) 

(31) 


Upon  substituting  the  foregoing  result  in  eq.  (25),  we  obtain  an  approximative  upper  bound  for  the  2-norm  of  5x, 
namely, 


||5x||2  <  y/2(n  -  l)||Mt||25arms. 


(32) 
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If  we  assume  the  error  is  evenly  spread  over  x,  we  can  compute  the  average  error  Sx  on  the  entries  of  x  as 

<  \\8x\\2/y/2n  +  9.  (33) 

Thus,  the  error  Sw  on  the  entries  of  W  can  be  estimated  as 

Sw  =  Sx/l.  (34) 

From  the  definition  of  W,  it  is  apparent  that  the  angular  acceleration  Co  can  be  computed  from  the  angular  accelera¬ 
tion  matrix  as 


Co  —  vect(W)  =  - 


^3,2  —  ^2,3 
Wl,3  —  ^3,1 
W2A  ~  W±o 


(35) 


where  wij  is  the  (i,  j)  entry  of  W.  Thus,  the  upper  bound  Sw  for  the  error  on  the  components  of  the  angular 
acceleration  becomes 


Sw  —  Sw 

4.2  Error  on  the  Angular  Velocity  to 


2n  -  2  ||Mt||25a. 
2n  H-  9  l 


(36) 


Two  methods  have  been  used  to  compute  the  angular  velocity  in  previous  works.  The  two  methods  proposed  are 
reviewed  here,  and  corresponding  error  estimates  are  derived. 


4.2.1  First  Method:  Integrating  the  Angular  Acceleration 

In  this  method — see  Padgaonkar  et  al.  (1975)  and  Mostov  (2000),  for  example — the  angular  velocity  at  time  t  is 
computed  as 


co(t)  u;(0)  +  f  c o(r)d 

Jo 

No  matter  what  the  integration  method  is,  we  always  have 


T. 


(37) 


to(t)  ~  u;(0)  +  At  y^o;(jAf), 
j= 1 


(38) 


where  t  =  kAt  and  At  is  the  time  interval  between  to  acceleration  measurements — At  is  assumed  to  be  constant. 
Thus,  the  error  Sw  on  the  angular  velocity  components  becomes 


Aw  ~  At  Sw  {j  At) 

3  = 1 


< 


2n-2||Mt||2  k 
2  h  +  9  l 


AtE  Scirms  • 

3  = 1 


(39) 

(40) 


Here,  Sarrns  was  defined  as  a  constant  and,  therefore,  it  can  be  taken  out  of  the  sum.  Doing  this  yields  an  upper 
bound,  which  is  too  large.  Instead,  we  can  replace  it  by  the  random  variable  5an(t),  which  gives 


Ft  | 


Su  &  xt2n  2||M  112  A  (sa\x  +  Sa^(jAt))  . 

3= 1 


2n  H-  9  l 


(41) 


Assuming  that  the  noise  component  has  a  mean  value  of  0,  the  angular  velocity  error  due  to  the  bias  error  Swb  of  the 
right-hand  side  of  inequation  (41)  is 

Am  mnv/rti|2i 


2n  — 2  ||Mt||2t(5at 


2n  +  9 


l 


(42) 
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Upon  neglecting  the  variance  in  the  bias  errors  of  different  sensors,  the  central  limit  theorem  (Bendat,  1971)  yields 
the  standard  deviation 

Sujn  =  /2n  ~  2  llM  || 2  '  (43) 

V  2n  +  9  l 

Finally,  we  freely  add  the  average  and  the  rms-value  to  compute  the  upper  bound  duo,  that  is, 

duo  ;$  Suob  +  5uon.  (44) 

The  error  bound  is  found  to  grow  linearly  with  time,  which  is  natural,  since  time-integration  is  an  unstable  process — 
it  has  one  imaginary  pole.  To  cope  with  this  problem,  Parsa  et  al.  (2003a)  proposed  to  compute  the  angular  velocity 
from  the  centripetal  acceleration. 


4.2.2  Second  Method:  Square-Rooting  the  Centripetal  Acceleration 

This  method  requires  that  an  estimate  d>  of  the  angular  velocity  be  computed  from  time-integration  of  the  angular 
acceleration,  namely, 


uo 


(t)  —  l o(t  —  At)  +  f  Lo{r)dr. 

Jt-At 


(45) 


Afterwards,  cv(t)  is  computed  as 


w[  =  witi  -  -tr(W), 


if  w'„  >  0 


else 


end  if 


iOi  =  sgn {Ui)\lwi,i  -  -tr(W), 


Ui  =  0,  i  =  1,2,3, 


where  cut  and  Ui  are  the  ith  entries  of  u>  and  uj,  respectively.  If  we  assume  that  the  sign  of  ~j,  can  be  determined 
accurately,  its  error  Suoi  depends  only  on  the  diagonal  entries  of  W.  Therefore,  we  can  write 


3  o  3 

Sui  =  Y 

^  dwj  i  J,J  ^  ^ 
j= i  '  j= i 


dui 


dw 


3,3 


3  Sw 

4  I  cud 


(46) 


If  we  have  to  compute  one  single  upper-bound  duo  to  the  angular  velocity  components,  then  we  take  the  maximum 
of  the  three  bounds,  namely 

r  r  3  dw 

duo  =  max  duoi  =  - : — r.  (47) 

*=1,2,3  4 mmj=i)2)3  \u3i\ 

This  last  expression  does  not  depend  on  time,  which  is  why  this  method  seems  attractive  as  compared  to  the  time- 
integration  method.  However,  it  brings  about  another  major  problem:  the  error-bound  blows  up  whenever  one  of  the 
angular  velocity  components  becomes  null.  Perhaps  a  combination  of  both  methods  is  desirable,  but  this  is  out  of 
the  scope  of  this  paper. 


5  SIMULATION  AND  VALIDATION  OF  ERROR  ESTIMATES 

Simulations  were  performed  in  order  to  validate  the  error  estimates  obtained  and  to  compare  the  performance  of 
all-accelerometer  strapdowns  with  that  of  gyroscopes.  The  simulation  was  carried  out  using  the  strapdown  shown  in 
Fig.  3(d).  The  accelerometers  are  taken  to  have  a  high  accuracy:  their  bias  errors  dahiX  follow  a  normal  distribution 
with  zero  mean  and  standard  deviation  of  0.1  mg,  while  their  noise  darL\  is  also  distributed  normally  with  a  1  mg 
rms-value. 
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The  virtual  motion  is  that  of  a  UAV  turning  in  circles  around  point  On,  as  shown  in  Fig.  4.  As  this  is  meant  to 
correspond  to  what  would  happen  in  a  typical  recognition  mission,  we  choose  plausible  values  of  speed  and  radius  of 
turn,  namely,  v  =  15  m/s  and  p  =  200  m.  This  corresponds  to  a  constant  angular  velocity  uo  =  [0  0  0.075]T  rad/s. 


Figure  4:  Sample  motion 

Figure  5(a)  shows  the  resulting  signals  from  one  of  the  three  accelerometers  located  at  Pi,  with  a  sampling  rate 
of  100  Hz.  The  sensitive  axis  of  this  accelerometer  is  parallel  to  the  pitch  axis  of  the  UAV.  The  components  of 
the  angular  acceleration  are  displayed  in  Fig.  6(b)  along  with  the  bounds  on  the  error  on  the  angular  acceleration 
components,  which  were  computed  using  eq.  (34).  The  values  of  ||M^  ||2  and  l  for  the  strapdown  used  are  4.807  and 
l  =  0.5554  m,  respectively,  while  the  measurement  error  is  taken  to  be  Sarms  =  1  mg.  Notice  that  for  the  prescribed 
motion,  the  real  angular  acceleration  is  null,  and,  therefore,  the  measured  angular  acceleration  cb  is  equal  to  its  error 
ScJ. 


Figure  5:  Signal  from  accelerometer  #1  at  point  Pi 

The  angular  velocity  was  computed  using  both  the  integration  method  and  the  centripetal  acceleration  method, 
leading  to  the  results  of  Figs.  7  and  8.  From  Figs.  6  and  7,  it  is  apparent  that  the  error  models  derived  for  the  angular 
acceleration  and  the  angular  velocity  computed  by  time-integrating  the  angular  acceleration  are  accurate.  However, 
the  error  bound  for  the  angular  velocity  computed  from  the  centripetal  acceleration  is  somewhat  too  large.  A  possi¬ 
ble  reason  for  this  is  that  all  higher-order  derivatives  of  8u)i  tend  to  infinity  as  cji  — >  0.  Therefore,  it  becomes  more 
difficult  to  predict  the  error  magnitude  at  low  angular  velocities.  Nevertheless,  the  estimated  error  bound  is  of  the 
same  orders  of  magnitude  as  the  simulated  error,  and,  therefore,  it  is  good  enough  for  engineering  purposes.  It  is 
also  seen  from  Figs.  7  and  8  that  both  methods  encounter  major  problems:  their  error  is  much  larger  than  the  angular 
velocity  to  be  measured.  The  question  is  now:  “can  anything  more  be  done  to  make  accelerometer  strapdowns  a 
viable  solution  for  inertial  navigation  of  UAVs?” 
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Figure  6:  Estimated  angular  acceleration 


(a) 


(b) 

Figure  7:  Angular  velocity  computed  with  the  time-integration  method:  (a)  estimates  and  (b)  errors 


One  could  propose  to  design  a  filter  to  reduce  the  noise  level.  Instead  of  doing  this,  let  us  simply  remove  the  noise 
component  from  the  accelerometer  readouts  to  see  if  filtering  has  the  potential  of  giving  satisfying  results.  Keeping 
only  the  normally-distributed  bias  error  Sa^ms  =  0.1  mg,  we  obtain  the  angular  velocity  estimates  of  Figs.  9  and 
10.  The  time-integration  method  still  yields  bad  results,  with  an  error  growth-rate  of  approximately  0.007  rad/s2. 
On  the  other  hand,  the  centripetal  acceleration  method  gives  more  promising  results:  without  noise,  the  estimates  of 
the  two  null  components  of  the  angular  velocity  vanish.  The  error  on  the  non-null  component  is  approximately  0.01 
rad/s^  2000°/h.  This  is  still  worse  than  most  of  low-cost  angular-rate  sensors.  For  example,  the  MEMS  angular-rate 
sensors  used  by  Brown  and  Lu  (2003)  have  an  accuracy  of  500°/h.  In  fact,  as  the  error  bound  is  proportional  to 
the  bias  in  the  accelerometers,  it  is  apparent  that  a  25  gg  accuracy  is  needed  to  obtain  the  same  accuracy  with  an 
accelerometer  strapdown. 
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Figure  8:  Angular  velocity  computed  with  the  centripetal  acceleration  method:  (a)  estimates  and  (b)  errors 


(a) 


(b) 

Figure  9:  Angular  velocity  computed  with  the  time-integration  method  from  noiseless  accelerometer  readouts:  (a)  es¬ 
timates  and  (b)  errors 
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(a) 


(b) 

Figure  10:  Angular  velocity  computed  with  the  centripetal  acceleration  method  from  noiseless  accelerometer  read¬ 
outs:  (a)  estimates  and  (b)  errors 
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6  CONCLUSIONS 

The  problem  of  estimating  the  angular  velocity  of  a  UAV  was  discussed  in  a  general  context,  and,  therefore,  the 
resulting  error  analysis  allows  one  to  compare  accelerometer  strapdowns  to  strapdowns  that  are  currently  used  in 
industry.  The  condition  number  of  matrix  M  was  found  to  be  an  appropriate  performance  index  to  assess  the  quality 
of  accelerometer  strapdown  geometries.  As  a  result,  the  corresponding  characteristic  length  represents  the  effective 
size  of  the  accelerometer  strapdown. 

Provided  that  the  strapdown  geometry  is  known  accurately,  a  safe  error  bound  was  found  and  validated  for  a 
stable  estimate  of  the  angular  velocity — that  is,  using  the  centripetal  acceleration  method.  This  error  bound  is  pro¬ 
portional  to  || || 2 — which  depends  only  on  the  strapdown  geometry — to  the  errors  in  accelerometer  readouts  San, 
to  1/  |  Ui  | — where  ujx  is  the  ith  component  of  the  angular  velocity — and  to  the  inverse  of  the  strapdown  size  l.  Among 
these  variables,  the  critical  parameter  is  the  error  in  the  measurements,  for  the  others  are  dictated  by  the  UAV  and 
its  motion.  The  noise  in  the  accelerometer  signals  can  be  reduced  through  filtering  and  sources  of  bias  error  can  be 
identified  and  accounted  for,  but  at  what  cost?  From  the  foregoing  error  results,  it  does  not  seem  worth  the  effort  to 
replace  angular-rate  sensors  with  accelerometers,  because  the  level  of  accuracy  expected  does  not  match  the  level  of 
accuracy  of  expensive  optical  angular-rate  sensors.  In  fact,  in  the  case  of  a  1  m  wingspan  UAV  and  for  the  motion 
considered,  the  accelerometer  strapdown  could  only  approach  the  accuracy  of  low-cost  angular-rate  sensors,  and 
this,  under  the  ideal  conditions  of  perfect  noise  filtering  and  with  a  bias  error  as  low  as  25  pg. 

Nevertheless,  accelerometer  technology  is  still  growing  quickly  and  it  may  render  all-accelerometer  strapdowns 
a  viable  option  for  UAV  INS  in  the  near  future.  In  this  eventuality,  the  error  formulas  introduced  here  can  be  used  to 
compare  an  all-accelerometer  design  with  an  angular-rate  sensor  design. 
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